#include <WProgram.h>
#include "ROB_Telemetry.h"
#include "ROB_Console.h"


void CConsole::Begin(void) {
  Serial.begin(CONSOLE_SPEED);

}

void CConsole::update(void) {

  Serial.println("status: ");
  Serial.print(" engineLSpeed="); 
  Serial.print(tmy.engineLSpeed,HEX); 
  Serial.print(" engineRSpeed="); 
  Serial.print(tmy.engineRSpeed,HEX); 
  Serial.print(" servoPanPos="); 
  Serial.print(tmy.servoPanPos,HEX); 
  Serial.print(" servoTiltPos="); 
  Serial.print(tmy.servoTiltPos,HEX); 
  Serial.print(" batterStatus="); 
  Serial.print(tmy.batteryStatus,HEX); 
  Serial.print(" irBar1="); 
  Serial.print(tmy.ir1Distance,HEX); 
  Serial.print(" irBar2="); 
  Serial.print(tmy.ir2Distance,HEX); 
  Serial.print(" irBar3="); 
  Serial.print(tmy.ir3Distance,HEX); 
  Serial.print(" irBar4="); 
  Serial.print(tmy.ir4Distance,HEX); 
  Serial.print(" irBar5="); 
  Serial.print(tmy.ir5Distance,HEX); 
  Serial.print(" irBarMax="); 
  Serial.print(tmy.irMaxDistance,HEX); 

  Serial.print(" ping="); 
  Serial.print(tmy.pingDistance,HEX); 
  Serial.print(" btnState="); 
  Serial.print(tmy.btnStatus,HEX); 
  Serial.println();

}



CConsole Console;

